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ABSTRACT 

In this article, we compare two forward kinematic formulation procedures for the 6DoF serial robot manipulator. 
Both formulation procedures are based on the screw theory. Screw theory based methods are alternative to the classical 
methods such as D-H (Denavit-Hartenberg) based conventions. The following two methods, successive displacement method 
and quaternion based method have been considered for comparison in this article. Compared to the successive screw 
displacement method, quaternion method is computationally efficient and compact. Kinematic modelling of both methods are 
presented with case studies and compared, concerning forward kinematics of the serial robot manipulator. 
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INTRODUCTION 

Kinematics is a fundamental part for the motion devices such as robots. The kinematic analysis of the robot 
manipulator provides the relationship between the end-effector positions and joint displacements. The forward 
kinematic analysis is the method of determining the position of end-effector, from the position of joints given. Since, 
the solutions of kinematic analysis are easy to attain and require very less number of computations, compared with 
equations of dynamics. 

Various methods have been used in robot kinematic study and screw theory is one of the significant method 
among them. Screw theory based solutions have been using in many applications of robotics for last few years. Robert 
S. Ball has developed the complete screw theory which is traced form the theorems of Chasales, developed by Chasles 
Poinsot in 1800[ 1 ]. In the screw theory every rigid body transformation, with respect to a coordinate system of 
reference frame can be described by displacement of screw, which is translation along the axis of rotation and by angle 
(/) about the same axis[2]. There are two important advantages of using screw theory for describing the kinematics of 
the rigid body. The first one is that it permits rigid body global description motion that helps to avoid singularities due 
to the use of local coordinates system. The second one is that it provides a geometric description of the rigid body 
motion which simplifies the mechanisms[3]. 

In this paper, we presented a comparative study for the forward kinematics formulation methods in which both 
are based on the screw theory. In these methods first one is based on the successive screw displacement method and the 
second one is based on the quaternion algebra. These two methods are given in [4] and[5]are extensively developed in 
formulations of mathematics and analysed in details. Additionally, case studies have been established for the both 
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methods using 6D0F robot manipulator. 

SCREW THEORY 

Screw theory is a geometric entity which characterises both translational and rotational quantities. It is poised of 
an axis, on which both translational and rotational quantities are defined, a scalar pitch which correlates both quantities [6]. 

Instantaneous motion of rigid body is represented by a twist which is relative to a reference frame. It is typically 
denoted with Plucker coordinates as £ = (CO ; V ) , where CO is the angular velocity of the rigid body about a certain axis 
and v is the instantaneous linear velocity of a point “O”, coincident with the origin, v has a component parallel to the axis 
another component is normal to the twist axis. This twist can be transformed into its magnitude p and normalised screw 

E, . Figure.la and Figure.lb represents the components of a screw and screw displacement respectively, where k denotes 
the screw axis and k a is a position vector of a point in axis of screw. According to Figure, la, p representation shown in 

Equation.(l) 


J 




Figure.lb: Displacements of Screw 

Translation and rotation are related by the screw pitch s: 


£ 
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k 

Ks + Kxk a 


ks + k 0 x k 


p=ip 


(i) 


Particularly there are two cases. When the motion is translational s = °° and so g = (0; k) T . For rotational 
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motion it is assumed that 5 = 0 ,and the normalized screw reduces to C, = (0; kxk) 1 


Along the screw axis helical displacement can represented by parameters of Rodrigues, as shown in Figure.l(b). 
These correspond to the k and k a , which defines axis of screw, the linear displacement c parallel to it and angular 

displacement 0 along the axis. The transformation matrix representation using these parameters expressed as shown in 
Equation. (2). This displays a screw that can be employed to define the rigid body position relative to a reference frame. 

M = \m q(c) 

0 1 


E{9) = 


SySx<\-t+)~KK 


U +k ^ l ~ t e) 

SySzQ*-t+)-k x kt 


s y s z (l-t^-k x k 0 

t, + k 2 z (l-t,) 


(3) 


q(c) = ck + [I - E(t/>)]k 0 


(4) 


A rigid body may undergo several displacements of screw and it can be denoted by an equivalent displacement of 
screw. Multiplication of two homogeneous matrices of each displacement results in the equivalent homogeneous matrix of 
screw displacement [7]. 

Forward Kinematic Modelling By the Using Successive Screw Displacement Method 

Considering a kinematic chain in which links are connected by various joints. So, the link i movement, relative to 
the predecessor link i-1, which is connected by a joint is denoted by a screw . The positon of a link relative to its 

predecessor is represented by the transformation matrix l l M i founded as in Equation.(2), from the parameters of the joint 
displacement. 

The position of a link h to a link g is represented by successive displacements of screw made by each joint in the 
sub-chain between h and g. The overall displacement is attained by homogeneous transformation matrix 1 " 1 M, pre 
multiplication as represented in Equation.(5). It is considered that, link g is successively displaced according to the 
movements of screw, from the joint nearest to the link h to the joint nearest to link g: 

g M h = 8 M 1 l M 2 . "~ l M n "M h 


Representations of screw are always relative to the system of reference frame coordinate. We can determine the 
kinematic equation of the robot manipulator, using any reference system. Once determined the screw in a system of 

referential frame, a transformation 'T■ should implement to attain its expression in different reference frame, ‘T. 
represented in Equation. (6), where £('q ■■) is the skew-symmetric matrix from the positon vector between them 1 E ■ 

and origins of two system. Where ' E . is the rotation matrix from the system j to system i, as represented in the 

Figure.2: 
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i ^= i T i = 


' E i 0 

CCPiYE; i E j 


( 6 ) 


Case Study 

In this case study a 6 DoF robot manipulator, modelled using successive screw displacements procedure. 
Figure.2a represents the schematic diagram of the elbow robot manipulator. In this robot manipulator, the second joint 
axis perpendicularly intersect with the first joint axis, the second joint axis is parallel to the third and fourth joint axis, the 

fourth joint with a small is offset distance / 4 is perpendicular to the fifth joint axis, and the fifth joint is perpendicular to the 
sixth joint axis. Firstly, reference configuration with respect to which the manipulator displacement should be measured. 
The Reference configuration has shown in Figure.2bwhere the first joint axis, ^ , vertically points up in the direction of Z; 
the second( S 2 ),third( ), and fourth! S 4 ) joint axes, are all directing out of the paper. The fifth joint axis( ) directing in 
the positive direction z-axis. The coordinate of system of hand is located at Q point such that W 0 -axis directs in the 
positive direction of x-axis and U () -axis directs in the positive direction of z-axis. At this position, the locations of the 
screw axes with respect to the frame of fixed reference are given below; 


i. 
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jo int 1: k t (0,1,1); k oi (0,0,0) 
joint 2 : k t (0-1,0 )\k oi (0,0,0) 
jo int 3 : k t (0-1,0); k oi (l 2 ,0,0) 
jo int 4 : £,.(0,-l,l);£ o ,.(/ 2 + / 3 ,0,0) 
jo int 5: k i (0,0,1); k oi ( l 2 + l 3 +l 4 ,0,0) 
jo int 6: k t (1,0,0) \k oi (0,0,0) 


The reference positions of the end effector are given; 

U 0 = [0,0,1 ] T 
v 0 =[0,-1,Of 
w 0 = [1,0,0] r 

q Q = [4 + 4 + 4 A0] r 


Now, end effector target position is given by 

u = [u x ,u y ,uj 1 
V = [V X ,V y ,V z f 
w=[w x ,w y ,w z ] T 
q 0 = i<i X ’<iy,q-J T 


Now, substituting the joint axes coordinates in to Equation. (5). We obtain the transformation matrices; 
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The matrix products l M 2 ~M 3 3 M 4 and°M x l M 2 2 M 3 ' M 4 are computed as 
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Quaternion Based Forward Kinematic Modelling for the 6DOF Robotic Manipulator 

Quaternion 

Quaternions are rank 4 hyper complex numbers, representing a four dimensional vector space over real numbers 
field [20,21]. The quaternion can be denoted in the form; 

P = (Po’Pv ) (7) 

Where p g is scalar quantity and p v is a vector. If p o = 0 then, we have pure quaternion. The two quaternions 
sum and product given as, 

Pa + Pb = (PaO + Pbo )>(PaV + C lbV ) (8) 

Pa®Pb= (PaoPbO-PavPbv)’(PaoPbv + PboPaV + PaV X Pbv) (9) 

Where ® represents the quaternion product. Norm, inverse and conjugate of the quaternion can be represented in 
the forms 


HI 2 = p® p* = Po+Pi + p\ + p\ 

p~ l= -ApP and INN 0 
INI 


( 10 ) 


( 11 ) 


P = (Pi~Pv) = (Po ~P\ ~Pi ~Pi ) 


( 12 ) 


that satisfies the p 


p= p® p 1 = 1 when 


p =1 ,we get quaternion unit that satisfies the 


* 

= P ■ 


Screw Theory Using Quaternion 

If the motion of screw axis does not pass through origin as represented in the Figure.3athen, the motion of the 
screw is given by 
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^3x3 C l 
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(13) 


In Eq. (13), screw motion is given by using homogenous transformation matrices (4x4) . It employs sixteen 
parameters while it needed only six parameters. By using quaternion algebra, we can represent screw motion in a more 
compact(efficient) form than homogenous transformation matrices. If we separate motion of screw as a translation and 
rotational then, we have 

Translation 


±_ 

2n 


Id + ( ^3x3 


- E{(f),d))q 


(14) 


and 


Rotation: E(<f>, d) 

Now by using quaternions, we can express these equations as follows; 

Translation 


c= p + q-p® q® p* 

Where p is the position vector and p is amount of pure translation. 


(15) 


Formalisation of Kinematic Modelling Using Quaternion Based Method 

In this method first we have to determine the joint axis vectors; First we attach axis vector which describes the 
joint motion. Later we have to obtain the transformation operators: these operators for all joints can be attained by using 
quaternions, as follows 

Translation 


Pi = Vi ~Pi® Pi® Vi 


Rotation: p t = sin(^-)6? ; , COS(-y) 


(16) 


Where q i represents the arbitrary point on the i ,h axis. 


Now, 

From Equation. (15) and (9) Rigid transformation of robot manipulator can be given as 

Position 


6Vl = Pin®Vh q ® Pln + Pu, 


(17) 
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Orientation: r 0+1 = p ln ® r 0 ® p* n 


Where r 0 , q hq denotes the end effector orientation and position before the transformation and r 0+1 , q hq+t denotes 
the end effector orientation and positon after the transformation. 

Case Study 

In this case study forward kinematic problem solved for the elbowserial robot manipulator using quaternion 

methods. 

Firstly, determination of all joints axes 

= d 4 = [0,0,l] 
d 2 =d 5 = [0,1,0] 

d 2 — d 6 — [ 1 , 0 , 0 ] ( 18 ) 

Any point on these axes can be given as 

di =q 2 =[0,0,r o ] 
q 3 =[r 0 ,0,r 0 \ 

q 4 =q 5 = q 6 =[)] + r 2 ,0,\\ (19) 

Secondly, the operators of transformation which are in quaternion can be given by using Equation.(16). At end 
the forward kinematic equation can be attained as follows. 

Position 


Pie ®de® Pie + Pie 

Orientation: 


( 20 ) 


P 16 ® r 6 ® P , 6 

Pi = dl ~ Pi ® dl ® Pi 

Pli = Pli-1 ® di- 1 ® Ptl ~ Pi, ® di ® Pli + Pi-1 

Pie = Pi® P 2 ® Pi® Pa® Pe® Pe® 
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Figure.3a: Reference Configuration of 6 Dot' Serial Arm Robot Manipulator 
Comparing the Methods 

Both successive screw displacement method and quaternion methods are systematic for identification of 
parameters and modelling of positional kinematics. The reference choice flexibility in successive screw displacement 
method is a significant feature, since it facilities the identification of parameter process and can be employed to attain 
simplified formulations. Parameter identification requires only two frames for the entire system. Only, one end effector 
coordinates system and one fixed coordinate system is required, we can choose the reference positon arbitrarily. In the case 
of forward kinematic analysis Joint variables represent actual displacements and derived by composition of homogeneous 
transformation matrices. 

Quaternions are compact and convenient mathematical representations, for expressing the rigid body’s attitude in 
three dimensions. Some of the advantages provided by quaternion based method are concatenating rotations are 
numerically more stable, singularity free, computationally faster, and unambiguousness. Extracting axis of rotation and 
angle is easy, Interpolation is straighter forward. Compared with the successive screw displacement method, quaternion 
based method solutions are computationally more efficient and they requires less storage area. This work is focused on 
serial robot manipulators, it is should be consider that use of screw based methods are straight forward for multi-robot 
systems and parallel manipulators. In detail, Davies method is appropriate application only to closed kinematic chains, 
which are inherent for multi-robot systems and can be identified in parallel manipulators. 

CONCLUSIONS 

This work is investigated two types of forward kinematic modelling of 6 D 0 F robot manipulators using case 
studies. The both screw based methods are less known but has few advantages in designing and modelling of kinematic 
chains. Both successive screw displacement method and quaternion based methods were applied to the same kind of robot 
manipulator model to simplify their comparison. It was observed that quaternion based method, apparently more intricate, 
is more flexible. The comparison made pointed that quaternion based method has advantages over the successive 
displacement modelling method in some perspectives. 
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